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I .      INTRODUCTION 

Autonomous  vehicles  that  are  suitable  for  use  in  both 
naval  and  commercial  operations,  have  unique  mission 
requirements  and  dynamic  characteristics.  In  particular,  they 
are  required  to  be  highly  maneuverable  and  very  responsive  as 
they  operate  in  obstacle  avoidance  and  object  recognition 
tasks.  The  need  therefore,  arises  to  maintain  accurate  path 
keeping  in  confined  spaces  under  the  influence  of  steady  and 
time  varying  external  excitation.  The  primary  vehicle 
guidance  system  is  based  on  heading  or  turning  rate  commands 
that  are  generated  based  on  a  specified  geographical  sequence 
of  desired  way  points.  These  guidance  commands  are  then 
passed  to  the  vehicle  controller  which  attempts  to  deliver  the 
commanded  heading  and/or  heading  rate  of  change  by  an 
appropriate  use  of  the  vehicle  control  surfaces  [Ref.l].  For 
vehicle  operations  in  confined  spaces  the  way  point  sequence 
must  be  very  dense  so  that  satisfactory  path  accuracy  is 
maintained. 

One  efficient  way  of  maneuvering  through  a  given  way  point 
sequence  is  by  using  a  line  of  sight  guidance  law  which 
commands  a  heading  angle  that  is  directly  related  to  the  line 
of  sight  angle  between  the  vehicle  position  and  a  desired 
destination  point.  The  vehicle  controller  is  then  an 
orientation  control  law  which  delivers  the  commanded  heading. 


Previous  studies  [Ref.2]r  have  demonstrated  that  this 
scheme  is  guaranteed  stable  only  if  the  way  point  separation 
is  above  some  critical  value.  This  conclusion  is  true 
regardless  of  the  particular  form  of  the  line  of  sight 
guidance  or  the  heading  control  law  used.  In  this  work  we 
analyze  the  turning  rate  guidance  and  control  problem  where 
the  guidance  law  demands  a  specific  yaw  rate  response  from  the 
controller.  A  linear  state  feedback  with  a  feedforward  term 
[Ref.3],  control  law  is  used,  while  two  different  guidance 
schemes  are  considered.  The  first  is  a  cross  track  error 
guidance  law  which  is  very  popular  in  land  based  robotic 
applications  [Ref.4].  The  second  is  a  proportional  guidance 
law  which  is  based  on  the  line  of  sight  angle  between  the 
vehicle  and  a  target  point.  Stability  analysis  is  performed 
and  numerical  integrations  are  used  to  confirm  the  theoretical 
results.  All  numerical  computations  in  this  work  are 
performed  for  the  Naval  Postgratuate  School  autonomous 
vehicle,  for  which  a  complete  set  of  geometric  properties  and 
hydrodynamic  characteristics  is  available  [Ref.5]. 


II.   EQUATIONS  OF  MOTION 

Restricting  our  attention  to  the  horizontal  plane,  the 
mathematical  model  consists  of  the  nonlinear  sway 
(translational  motion  parallel  to  the  vehicle  longitudinal 
axis)  and  yaw  (rotational  motion  about  the  vertical  axis) 
equations  of  motion.  In  a  moving  coordinate  frame  fixed  at 
the  vehicle's  geometrical  center  (see  Fig.l),  Newton's 
equations  of  motion  are: 

m{v  +  ur+xci)  =Y  (1) 

Jzr+mxG(i>  +  ur)  -N,  (2) 

where  m  is  the  mass  of  the  vehicle  ,  Iz  its  moment  of  inertia 
with  respect  to  the  vertical  axis,  u  the  forward  velocity,  xG 
the  coordinate  of  the  vehicle  center  of  gravity  with  respect 
to  its  centroid,  V  and  r  are  the  relative  sway  and  yaw 
velocities  of  the  moving  vehicle  with  respect  to  the  water; 
and  Y,  N  represent  the  total  excitation  sway  force  and  yaw 
moment,  respectively. 

Following  standard  vehicle  maneuvering  assumptions,  these 
forces  can  be  expressed  as  the  sum  of  quadratic  drag  terms  and 
first  order  polynomials  in  \)  and  r  with  constant  coefficients. 
In  this  way  the  nonlinear  equations  of  motion  in  the 
horizontal  plane  become 


m(v  +  ur+xGf)  =Yti  +  Yirv+Yrur  +  Yvuv+ 
+  F6u26-|cDh(0  (w+gr)  \v+ir\dl  (3) 

Izf  +mxG  ( v  +  ur )  =Nf  i  +Nvv+Nrui  ->-Nvuv+N6  u 2  6  - 

-0.5C/<V2(5)  (u+£r)  |ii+5r|W?  <4> 

In  equation  3  the  terms  Y;.,  Y^.  represent  the  change  in  the 
lateral  force  due  to  unit  changes  in  the  angular  acceleration 
r  and  the  lateral  translational  acceleration  v,  respectively. 
Likewise,  the  terms  Yv,  Yr  represent  the  change  in  the  lateral 
force  due  to  unit  changes  in  the  corresponding  velocities  v 
and  r.  The  terms  N^,  N^,  Nr,  Nv  in  equation  4  are  defined 
similarly.  CD  is  the  drag  coefficient  and  5  is  the  rudder 
angle.  The  NPS  AUV  II  is  equipped  with  both  stern  and  bow 
rudder  which  are  identical  in  size  and  are  deflected  in 
opposite  directions  for  maximum  maneuverability.  In  other 
words 

5S=5,      6b=-C  (5) 

where  5,  is  the  stern  rudder  angle,  and  5b  the  bow  rudder 
angle.  The  cross  flow  integral  drag  terms  in  the  equations  of 
motion  become  important  for  hovering  operations  or  low  speed 
maneuvering,  whereas  at  high  speeds  u  the  steering  response  is 
predominantly  linear. 

To  complete  the  model,  we  need  the  expressions  for  the 
vehicle  yaw  rate 


i|/=r  ,  (6) 

and  the  inertial  position  rates 

x=ucosT  -  vsinT  ,  (7) 

y=usinT  +  vcosT  ,  (8) 

where  5„  is  the  vehicle  heading  angle  as  shown  in  Figure  1. 
Although  it  is  recognized  that  the  steering  gear  is  both  rate 
and  angle  limited,  steering  gear  dynamics  are  not  included  in 
the  formulation  since  they  are  much  faster  than  the  dynamics 
of  a  turning  vehicle.  The  methods  presented  in  the  following 
sections  can  easily  accommodate  such  modifications  if  desired. 
The  surge  velocity  u  is  clearly  affected  during  the  trim 
due  to  the  added  drag  in  turning.  For  the  purposes  of  this 
study,  it  is  assumed  to  be  constant.  This  is  a  valid 
approximation  since  experimental  experience  has  shown  that  the 
propulsion  control  law  is  in  general  capable  of  keeping  the 
forward  speed  u  relatively  constant  at  the  commanded  value. 


Figure  1.   Vehicle  Geometry  and  Definitions  of  Symbols 


III.    CONTROL  LAW  DESIGN 

A.   LINEARIZATION 

As  was  mentioned  in  the  previous  chapter,  during  regular 
cruising  operations  at  about  2  ft/sec  forward  speed,  the 
nonlinear  term  in  the  equations  of  motion  3  and  4  are  small 
and,  therefore,  effective  control  can  be  maintained  by  using 
their  linear  form 

m(i)  +  ur+xGr)  =  Ytr  +  Yvv+Yrur+Yvuv+Ybu2b  .  (9) 

Izf+mxG(i)  +  ur)  =Ntf+N<rv+Nrur+Nvuv+Nbu2b  .        (10) 

After  some  algebra,  equations  9  and  10  can  be  put  into 
state  space  form  as 

v  =  a11uv+alzur+b1u2b ,  (11) 

r   =  azluv+a2Zur+b2u2b  ,  (12) 

Daxl   =  {Iz-Nt)Yv-{mxG-Y±)Nv 

Da12   =  (Iz-Nt)  (m-Yr)-(mxG-Yt)  {Nz-mxG)  , 

Da21   =  {m-Yv)Nv-{mxg-Nv)Yv, 

DaZ2   =  {m-Y+)  (Nr-mxG)  -{mxG-Nv)  {Yz-m)  , 
Db,  =   {iz-Nt)Y6-{mxa-Yt)Nt. 


where 


Db2  =   (m-  YJ  Nb -  (mxG-Nv)  Yb , 

D   =  (Iz-N±)  im-Y^,)  -(mxG-Yt)  (mxG-Nv)  . 

Equations  11  and  12  describe  the  lateral  dynamics  of  the 
vehicle  for  small  motions. 

B.   FEEDBACK  CONTROL 

A  linear  rudder  feedback  control  law  based  on  equations  11 
and  12  has  the  form 

5  =  kvv+kzr,  (13) 

where   k,,    kr   are   the    feedback   gains.    By   substituting   equation 
13    into    11    and   12   we   get   the    closed   loop   dynamics    equations 

v-    {a11u+b1u2kv)  v+  (a12u+jb1u2icr)  r,  (14) 

r  -    {a21u+b2u2kv)  v+  {a22u+b2u2kr)  r  (15) 

The   characteristic   equation   of   14    and   15    is 

k2+Axk+A2   =  0,  (16) 

where 

Ai  =    tan+a22+  (bxkv+b2kr)  u]  u, 

A2=  [aiia22-ai2a21+  (^Ia22-i:)2ai2)  Ukv+  (^ll  "^l^l )   Ukr^  U"  ■ 

Now  the  desired  closed  loop  characteristic  equation  is 


l2+a1X+a2  =   0  (17) 

By  equating  the  coefficients  of  eqs.16  and  17  we  get  the 
following  system  of  linear  equations 

V2^"2/  -a1-(a11+a22)u,  (18) 


^v(a22^1-ai2^2)u3+^r(aiA-a21i:>i)u3  =  a2~ 

-  (ai:La22-a12a21)  u 


(19) 


Equations  18  and  19  then  determine  the  gain  kv,  kr,  in  the 
feedback  control  law  (Eq.13). 

The  coefficients  0^,  a2  of  the  desired  characteristic 
equation  17  can  be  specified  according  to  any  standard  pole 
placement  design  technique.  In  this  work  we  decide  to  use  the 
controller  time  constant,  Tc,  as  the  parameter  that  specifies 
the  coefficients  oq,  oc2.  In  this  way  the  desired 
characteristic  equation  is 

(A  +  _L)=0   Or   ^24^~=0  (20) 

and  comparing  with  eq.17  we  see  that 

«i  -  -f    '    *2  =  -h  <21) 

c  lc 

Specification  of  a  controller  time  constant  Tc  then 
determines  the  feedback  gains  kv,  kr  uniquely. 


C.   FEEDFORWARD  CONTROL 

The  control  law  (Eq.13)  guarantees  stability  of  v  =  r  =  o 
of  equations  11  and  12 ,  in  other  words  straight  line  motion  at 
an  arbitrary  heading.  When  the  commanded  angular  velocity  rc, 
is  nonzero  the  control  law  is  slightly  modified  to 

6  =  kvv+kz(r-rc)+kcrc,  (22) 

where  rc,  is  the  commanded  turning  rate  and  kc,  is  the 
feedforward  gain.  This  is  computed  based  on  steady  state 
accuracy  requirements.  At  steady  state,  equations  11  and  12 
yield 

v  =  vcrc      ,    6  =  bcrc  (23) 

where 


v    _  ^Ia22     -^2a!2  g     _  a2iai2     aiia22  /£4) 

b2axl-bxa21    '      c    2?2a11-i1a21u 


c 


Substituting  equations  23  and  24  into  equation  23,  and 
requiring  that  r  =  rc  at  steady  state,  we  can  solve  for  kc, 

kc  =  hc-kvvc  ,  (25) 

and  the  control  law  (Eq.22)  becomes 

&=kvv+kzr-  (kz-bc+kvvc)  rc   . 

Substituting  the  values  of  kr,  50,  kv,  vc  in  (26)  ,  we  can 
finally  write  the  control  law  (Eq.26)  in  the  form 
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o  =  kvv+krr-k0a2rc  ,  (27) 

where 

k0  =  - .  (28) 

(^2a11--b1a21)  u3 

With  the  above  feed  forward  gain  the  control  law  is 
complete.  It  should  be  mentioned  that  all  gains  K^,  kr,  k0 
depend  explicitly  on  the  forward  speed  u  and  are,  therefore, 
continuously  updated  every  time  a  different  forward  speed  is 
commanded. 

D .   RESULTS 

The  response  of  the  control  law  (Eq.27)  applied  to  the 
system  of  Equations  11  and  12  is  shown  in  Figure  2,  where  the 
commanded  turning  rate  is  0.1  rad/sec.  It  can  be  seen  that 
the  actual  vehicle  turning  rate  r  converges  to  its  commanded 
value  rc,  as  expected.  The  gain  were  computed  based  on  a 
selected  time  constant  Tc  =  1  dimensionless  second.  Time  is 
nondimensionalized  here  with  respect  to  the  vehicle  forward 
speed  u  =  2  ft/sec  and  the  vehicle  length  L  =  7.3  ft. 
Therefore,  one  dimensionless  second  corresponds  to  3.65 
seconds  of  real  time  and  this  is  verified  by  the  simulation 
results  of  Figure  2  (the  response  drops  about  60%  every  time 
constant) . 

The  response  for  different  time  constants  (in 
dimensionless  seconds)  is  shown  in  Figure  3  where  it  can  be 
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seen  that  higher  values  of  Ta,  result  in  slower  vehicle 
response  as  expected.  Similar  is  the  rudder  angle  response  as 
shown  in  Figure  4.  Smaller  values  of  Tc,  result  in  tighter 
control  and  more  rudder  activity. 

E .   ACCURACY 

The  feedforward  gain  k0  computed  from  eq.2  8  ensures  that 
the  steady  state  turning  rate  r  equals  the  commanded  value  rc 
for  the  linear  system  of  equations  11  and  12.  To  analyze  the 
effects  of  nonlinearities  we  start  with  the  nonlinear 
equations  of  motion  3  and  4  and  we  write  them  in  the  form 

v-  a11uv+a12ur+b1u2b  +  dv(v,  r)  f  (29) 

f  =  a12uv+a22ur+b2u2b+dr  (v,  r)  ,  (30) 

Ddv(v,  r)  =-0.5QCD[  (Iz-Nt)  Ix+{Yt-mxG)  It]    , 
Ddr  (v,r)=-0.  5QCD  [  {m-Yj  ]  I^iN^-mXs)  Iz]    , 
D=[Iz-Nt)  (m-Yi,)  -(mxG-Yt)  (mxG-N^)    , 

I^fhit)   (u+£r)  |v+£r|d£  , 

I2=fhiZ)  (v+Zr)  \v+lr\Zdl   . 

The  values  of  v  and  r  at  steady  state  can  then  be  computed 
from 
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Figure  2.    Turning  Rate  Response  for  Tc-1 
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Figure  3.   Turning  Rate  Response  for  Different  Values  of  Tc 
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Figure  4.   Rudder  Angle  Time  Histories  for  Different  Values  of  Tc 
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a11uv+a12ur+b1u2b+dv{v,  r)  =0  ,  (31) 

a21uv+a22ur+b2u2b+dr  [v,  r)  =0  ,  (32) 

b-kvv-kzr+k0a2rc=Q   .  (33) 

The  solution  to  these  equations  is  not  r  =  rc  unless  d^  = 
dr  =  0 .  This  is  demonstrated  by  the  time  simulation  of  Figure 
5,  for  which  the  quadratic  drag  coefficient  Cd  was  set  equal 
to  0.5.  It  can  be  seen  that  the  vehicle  turning  rate  develops 
a  nonzero  steady  state  error  with  respect  to  the  commanded 
value  of  0.1  rad/sec.  As  the  controller  time  constant  Te  is 
decreased,  the  control  law  becomes  tighter  and  this  steady 
state  error  could  not  become  zero  due  to  uncertainties  in  the 
vehicle  hydrodynamic  description  and  various  unmodeled 
dynamics.  Even  if  k0  were  determined  from  equations  31  to  33 
such  that  r  =  rc,  the  uncertainties  involved  in  the 
determination  of  the  hydrodynamic  coefficients  in  the 
equations  of  motion  would  cause  the  actual  value  of  r  to  be 
different  than  the  commanded  value  rc.  One  way  to  ensure 
steady  state  accuracy  is  to  abandon  the  use  of  the  feedforward 
gain  k0  and  to  introduce  integral  control.  This  possibility 
is  examined  in  the  next  section. 


16 


0.3 


0.25 


0.2 


o 

V 
si 

^o  0.15 

cd 
u 


0.1 


0.05 


- 

1 

1 

!- 

i 

■    —          n 

1                           1 

_ 

/  2 

- 

1 

0.5 

,'''' 

y' 

. 

1 

""!>— 

r*' 

1 

s* 

1 

,' 

''* 

1 

/Tc=l 

,-'''' 

I 

/' 

i 

1                                 1 

10      15      20      25      30      35      40 
time  (sec) 


Tigure  5.     Turning  Rate  Response  for  Different  Values  of  Tc  and  for 
Nonzero  Drag  Coefficient. 
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F.   INTEGRAL  CONTROL 

An  alternative  way  to  ensure  stability  and  convergence  to 
the  commanded  value  rc  is  to  introduce  integral  control  in  the 
form 


6=kvv+kr(r-rc)  +kTf  (r-rc)  dt  (34) 


In  that  case,  the  system  of  state  equations  is  augmented 
by  the  additional 

fr  =  r-rc  (35) 

In    order   to    compute   the    gains    kv,    kr,    kT   we    set    rc   =    0    and 
substitute   the    control    law 

b=kvv+krr+kIrI  ,  (36) 

into  equations   11   and  12.      The  resulting  closed  loop  system  is 

v=  (a11u+kvb1u2)  v+  (a12u+icIjb1u2)  r+icIjb1u2rI  (37) 

(38) 

f  =  (azlu+kvb2u2)  v+  (a22u+icrjb2u2)  r+kIbzwirI 

tx  =  r  (39) 

The    characteristic   equation    of   equations    37    to    39    can   be 
computed   as 

A.3+A1A2+aa+a3  =  0 
where 
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A1  =  -(a11+a22)u-b1u2kv-b2u2kI  , 

A2=  {axla22-a21a12)  u2+  (a^-a^^)  u3icr  + 
+  (a22bx-a12b2)  u3kv-b2u2kT 

If  the   desired  characteristic   equation   is 

A3+a1A.2+a2A+a3=0  (41) 

by  equating  the  coefficients  of  equations  40  and  41  we  get  the 
following  system  of  linear  equations  which  determines  the 
three   gains    kv,    kr,    kt: 

kjDlu2+kzb2u2  =  -a1-{a11+a22)  u  , 

-  (a11a22-a2la12)  u     , 

kI(a11b2-a21b1)u2=a3   . 

For  a  time  constant  Tc  and  an  integrator  time  constant  Tlf 
the  desired  characteristic  equation  becomes 

or 

A3+(A+J_)A2+(^L+_JL_);u_^=0   , 
Ti     Tc  T2C      TxTc  t2Tj 

so   that 
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rr     -     1  2 

a,  = —  +  — 

T      T 
1 1      1  c 


1  2 


02=        r  + 


T2C      TTTC 


a3  =  ^    • 

T2CTT 

With  these  choices  the  determination  of  the  gain  k,,  kr, 
kx,  is  complete.  A  numerical  simulation  for  rc  =  0.1  rad/sec. 
and  with  CD  =  0.5  is  presented  in  Figure  6.  The  time 
constants  are  Tc  =  1  and  Tz  assumed  the  three  different  values 
shown  in  the  figure.  It  can  be  seen  that  despite  the 
nonlinear  drag  terms,  steady  state  accuracy  is  achieved. 
Since  the  response  of  systems  compensated  by  integral  control 
action  tends  to  be  more  oscillatory,  in  this  work  we  will  use 
the  previous  feedforward  control.  As  we  show  in  the  next 
chapter,  steady  state  accuracy  is  guaranteed  once  the  control 
law  is  combined  with  a  suitable  guidance. 
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IV.   GUIDANCE  LAW 

A.  GENERAL 

The  previously  developed  control  law  is  able  to  deliver  a 
vehicle  commanded  turning  rate  rc.  In  order  to  achieve  path 
control  to  a  commanded  route  in  the  horizontal  plane,  however, 
the  commanded  turning  rate  rc  must  be  appropriately  selected. 
This  constitutes  the  guidance  law  design.  Two  such  guidance 
laws  are  described  in  the  following,  cross  track  error  and 
proportional  guidance.  Without  loss  of  generality,  we  assume 
that  the  commanded  path  is  a  straight  line.  This  is  not  a 
very  restrictive  assumption  since  every  smooth  path  can  be 
discretized  into  a  series  of  straight  line  segments  as 
accurately  as  desired. 

B.  CROSS  TRACK  ERROR  GUIDANCE 

The  guidance  law  is  based  solely  on  kinematics,  whereas 
vehicle  dynamics  are  handled  by  the  control  law.  Guidance  law 
development  based  on 

i  =  rc  (42) 

y  -   usinijj  ,  (43) 

where  rc  is  the  commanded  turning  rate  and  the  lateral 
velocity  v  is  assumed  to  be  zero  in  equation  43. 
Cross  track  error  guidance  is  achieved  by 
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rc   =  k,y+kyy  (44) 

By  substituting  equation  44  into  equation  42  we  get  the 
closed  loop  guidance  system 

ijr   =  lcti|r+jct!|r    ,  (45) 

y  =  usinijr   ,  (46) 

The  characteristic  equation  of  equations  45  and  46  is 
obtained  by  making  the  small  angle  approximation  sin\j/  =  \yr  and 
is 

\2-ky\-kyu   =  0  .  (47) 

If  the  desired  characteristic  equation  is 

A2+P1A+P2  =  0  ,  (48) 

the  guidance  law  gains  k^,  ky  are  obtained  by  equating  the 
coefficients  of  equations  47  and  48 

^  =  -Px  ,  (49) 

kv   =  -ii  .  (50) 

y  u 

Analogously  to  the  control  law  design,  if  the  time  control 
of  the  guidance  law  is  selected  to  be  TG,  then  equations  4  9 
and  50  result  in 

*♦  =  -!-.  (51) 

1G 
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ky  =  "ZT   ■  <52> 

TrM 


Selection  of  TG  then  determines  ky,  ky  directly. 

Although  this  development  followed  the  small  angle 
approximation,  it  is  not  difficult  to  see  that  negative  values 
of  ky  and  ky  will  guarantee  stability  of  the  nonlinear  system 
of  equations  45  and  46.  The  associated  total  energy  of  the 
system  is 

E(ij/,i|/)  =  ±ty2-kyu(l-cosq)    ,  (53) 

which  can  be  viewed  as  the  sum  of  kinetic  and  potential 
energy.   Using  equation  45,  this  is  written  as 

E{ty,y)=±  (k^+kyy)2-kyu(l-cos^)    .  (54) 

We  note  that  E(Y,  y)  provides  a  Liapunov  function  for  equations 
45   and   46,   since   E(0,0)=0   at   the   unique   equilibrium 
WrY)  =  (0,0)   and  E  (y,  y)  >0  for   (\|f,  y)  *  (0,  0)  ,   because  ky<0   . 
Moreover,  we  have 

^dExd$,  +  dExdy=dE         dE^  (55) 

cty  dt     dy     dt     di|/T  dyy 

Evaluating  the  indicated  partial  derivatives  we  get 

-^  =  (k^+kyy)k^-kyiis±ny  ,  (56) 


dE 
dy 


=  (k^+kyy)ky   .  (57) 
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Substituting  equations  45,  46,  56  and  57  into  equation  55 
we  find 

E=kiik^+kyy)2   ,  (58) 

which  is  negative.  Therefore,  Liapunov' s  theorem  guarantees 
asymptotic  stability  of  the  nonlinear  system  (equations  45  and 
46)  . 

C.   PROPORTIONAL  GUIDANCE 

A  typical  orientation  based  guidance  law  is  pursuit 
guidance  which  is  accomplished  as  follows:  The  commanded 
vehicle  heading  angle  \\fc  equals  the  line  of  sight  angle 
between  the  vehicle  and  a  target  point  D  located  ahead  of  the 
vehicle  and  a  constant  preview  distance  d  on  the  nominal 
straight  line  path  as  shown  in  Figure  1 .   In  other  words 

i|r.  =  -tan"1^  .  (59) 

d 

In  a  proportional  guidance  scheme  a  time  constant  T  is 
incorporated  in  the  above  line  of  sight  equation 

Ti|/c+i|rc  =  "tan"1^   ,  (60) 

and  we  arrive  at  the  proportional  guidance  which  is  used  here 
for  path  control 

rrc+t|>  =  -tan"1^  ,  (61) 

a 
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r  ^-ly-ltan'1^   .  (62) 

c  TY     T  d 

The  linearized  form  of  equation  62  is 

rc  =   -li|r--A-y  ,  (63) 

T        Td 

and  by  comparing  it  to  equations  48  through  50  we  can  see  that 
it  corresponds  to  a  guidance  characteristic  equation  with 


Px  =  \  ,  (64) 


P2  «  -^    •  <65> 

2        Td 
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V.    STABILITY 

A.   SIMULATIONS 

In  order  to  assess  stability  of  the  combined  guidance  and 
control  law  we  proceed  first  by  a  series  of  numerical 
integrations.  The  simulations  are  based  on  the  dynamical 
equations  3  and  4  and  the  kinematic  equations  6  and  8.  The 
rudder  control  law  in  the  form  of  equation  27  is  used,  while 
the  cross  track  error  guidance  (eq.44)  is  employed.  Results 
are  presented  in  terms  of  the  lateral  deviation  y  in  ft  versus 
time  t  in  seconds.  Figure  7  shows  the  vehicle  response  for 
control  time  constant  Tc=0 . 5  and  guidance  time  constant  TG=1 . 
It  can  be  seen  that  the  response  is  stable,  although  it 
exhibits  slow  convergence  characteristics  to  the  commanded 
path  y=0 .  To  speed-up  speed  of  response  we  could  lower  the 
guidance  time  constant  TG.  The  results  of  the  simulation  for 
Tc=0 . 5  and  TG=0 . 5  are  presented  in  Figure  8 .  It  can  be  seen 
that  the  convergence  is  now  faster  although  the  path  overshoot 
is  higher.  If  we  maintain  the  same  guidance  time  constant 
TG=0.5  and  increase  the  control  time  constant  Tc=2,  the  vehicle 
is  unstable  as  demonstrated  by  Figure  9.  The  response 
exhibits  now  oscillatory  characteristics  or  a  limit  cycle. 
The  explanation  for  this  phenomenon  is  that,  in  this  case  the 
control  law  is  very  slow  and  the  rudder  cannot  follow  the 
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commanded  turning  rates  by  the  guidance  law  which  is 
considerably  faster,  due  to  its  smaller  time  constant.  To 
remedy  this  instability  we  should  either  lower  Tc  as  in  Figure 
8  demonstrated,  or  increase  the  value  of  TG.  The  results  of 
this  simulation  are  shown  in  Figure  10,  for  which  Tc=2  and 
TG=2 .  The  response  exhibits  now  characteristics  of  a  damped 
oscillation  and  is  stable,  although  convergence  is  very  slow 
and  oscillatory. 

B.   STABILITY 

The  previous  simulation  results  show  that  there  exists  a 
certain  range  of  (Tc,  TG)  combinations  that  results  in  stable 
response.  In  order  to  compute  this  range  and  verify  the 
numerical  integration  results,  we  use  the  linearized  equations 
of  motion 

ijr  =  r  <66> 

v=a11uv+alzur+b1u26 ,  (67) 

f=a21uv+a22ur +Jb2u26,  (68) 

y=iii|r  +  v  (69) 

the    rudder   control    law 

S=kvv+krr-k0a2rc,  (70) 

and  the   turning   rate   guidance    law 

rc=fcti|r+Jcyy.  (71) 
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where 


In  a  compact  vector  notation  the  linearized  equations  of 
motion  66  through  71  are  written  as 

X=AX>       X"{^,v,z,y]  (72) 

Motion  stability  is  established  by  the  eigenvalues  of 
matrix  A,  if  all  eigenvalues  have  negative  real  parts  the 
nominal  straight  line  motion  is  dynamically  stable,  while  if 
at  least  one  eigenvalue  of  A  is  positive,  the  system  is 
unstable.  Writing  out  the  characteristic  equation  of  equation 
72  we  get 

A4+BA3+CA2+DA.+£=0,  <73> 

B=ax   ,  (74) 

C=a2-(Jb1p2+Jb2uP1)  uk0a2   ,  (75) 

Z?=a2P1+dia2P2   ,  (76) 

£=a2p2   ,  (77) 

and 

d =-—! Z—H L_22.    r  (78) 

(^2ail-^ia2l)   U 

In  the  derivation  of  expressions  74  to  78  we  have  used 
equations  18  and  19  for  the  feedback  gains,  equation  2  8  for 
the  feedforward  gain,  and  equations  4  9  and  50  for  the  general 
guidance  law  gains. 
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If  we  apply  Routh' s  criterion  to  the  fourth  order  equation 
73  we  can  find  the  following  critical  condition  for  stability 

BCD-B2E-D2>0    .  (79) 

If  we  substitute  equations  74  through  77  in  equation  79, 
we  find  the  following  condition 

«i«2[l-(^P2^2Pi)"2^]  (P1^cf1P2)-a12P2  _        (80) 

Equation  80  represents  in  algebraic  form  the  critical 
condition  for  stability  in  terms  of  the  control  law 
characteristic  equation  coefficients  0^,  (Xj  and  the  guidance 
law  coefficients  $lt  (32  •  It  can  t»e  used  for  both  the  cross 
track  error  and  the  proportional  guidance  schemes,  if  we 
employ  the  appropriate  expressions  for  plf  P2  from  Chapter  IV. 

For  the  case  of  cross  track  error  guidance,  equation  80 
results  in 

T  _  2  [TG2-(b1+2b2TGu)  uk0]   (22y^)  {Q1) 

C  4TG2+(2TG+d1)2 

For  a  given  guidance  law  time  constant  Tc,  equation  81 
specifies  the  critical  control  time  constant  for  stability. 

Stability  of  the  combined  guidance  and  control  scheme  is 
guaranteed  for  values  of  Tc  that  are  less  than  the  critical 
value  computed  from  equation  81.  For  Tc  values  above  the 
critical  value  (eq.80)  the  system  is  unstable.  In  these 
cases,  one  pair  of  complex  conjugate  eigenvalues  of  matrix  A 
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in  equation  72  has  positive  real  parts,  and  as  a  result  the 
response  of  the  system  is  oscillatory. 

A  plot  of  the  critical  stability  condition  (Eq.81)  is 
shown  in  Figure  11.  the  response  is  stable  for  (Tc,  TG) 
combinations  that  lie  below  the  critical  curve.  The  number  1 
through  4  on  the  figure  correspond  to  the  four  numerical 
simulations  that  were  presented  in  Figure  7  through  10, 
respectively.  It  can  be  seen  that  the  simulation  results  agree 
with  the  stability  analysis  performed  in  this  section.  Point 
3  is  located  above  the  critical  curve  and  the  results  in  the 
unstable  oscillatory  response  observed  in  Figure  9. 
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Figure  7.   Path  Keeping  Response  for  Tc=0.5,  TG-1 
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Figure  8.   Path  Keeping  Response  for  Tc=0.5,  TG=0 . 5 
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Figure  9.   Path  Keeping  Response  for  Tc-2,  TG=0 . 5 
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figure    10.       Path   Keeping   Response    for   Tc=2,    TG=2 
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Figure  11.   Critical  T0,  TG  Curve  for  Stability. 
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VI.     CONCLUSIONS  AND  RECOMMENDATIONS 

The  goal  of  this  work,  stability  analysis  of  turning  rate 
guidance  and  control  for  autonomous  vehicles  has  been 
achieved.  The  control  law  was  based  on  the  dynamic  equations 
in  sway  and  yaw.  The  feedback  gains  were  analytically 
computed  by  pole-placement  techniques  and  the  feedforward  gain 
was  evaluated  based  on  the  desired  steady-state  accuracy. 

The  guidance  laws  that  were  utilized,  cross-track  error  or 
proportional  guidance,  were  based  on  the  kinematics  relations. 
It  was  found  that  unless  the  guidance  and  control  laws  were 
designed  according  to  certain  conditions,  stability  of  the 
system  was  not  guaranteed.  These  stability  conditions  were 
computed  analytically  and  the  results  were  verified  by 
numerical  simulations.  Recommendations  for  future  work 
include  an  analysis  of  the  performance  of  turning-rate 
guidance  and  control  from  the  point  of  view  of  sensitivity  to 
sensor  noise,  state  estimation,  and  disturbance  rejection. 
Comparisons  with  other  guidance  and  control  laws,  such  as  line 
of-sight  guidance,  should  also  be  performed. 
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